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(54) Title: A CONTROL SYSTEM AND METHOD FOR CONTROLLING ONE OR SEVERAL MANIPULATORS 

(57) Abstract: A control unit for controlling one or more 
manipulators (2). wherein the control system comprises one 
or more computers (4, 6) and one or more drive units (8) for 
controlling the manipulator. The control system comprises a 
plurality of separate modules (12, 14) adapted to h andle vari ous 
functions, wherein each of the modules has its own jxJwer- 
supply and is adapted to communicate with at least one of 
the other modules, the computers (4, 6) and the drive units (8) 
being arranged in the modules. A method for controlling one 
or more manipulators, wherein the control system comprises 
one or more computers (4. 6) and one or more drive units (8) 
for controlling the manipulators. The control system is divided 
into a plurality of separate modules adapted to handle various 
functions, wherein the modules are provided with their own 
power supply and are brought to communicate with at least one 
of the other modules. 
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A CONTROL SYSTEM AND METHOD FOR CONTROLLING ONE OR SEVERAL 
MANIPULATORS 

TECHNICAL FIELD 

The present invention relates to a control system for 
control of one or more manipulators/ wherein the control 
system comprises one or more computers and drive units for 
controlling the manipulators. A manipulator is a movable 
mechanical unit, the movements of which are driven by one 
or more motors. The invention is applicable to all types of 
mechanical units, whose movements are controlled by a com- 
puter program. Examples of manipulators are industrial ro- 
bots and means of transport such as roller conveyors. The 
invention is especially useful in connection with the con- 
trol of industrial robots. 

The present invention also relates to use of the control 
system according to the invention for control of an indus- 
trial robot. 

The present invention also relates to a method for control 
of one or more manipulators. 

BACKGROUND ART 

An industrial robot comprises a plurality of arms that are 
rotatable relative to each other about a plurality. of axes. 
The movements of the axes are driven by motors mounted on 
each axis. The speeds and accelerations of the axes are 
controlled by the control system of the robot that genera- 
tes control signals to the motors . The control system com- 
prises drives that control the motors by converting direct 
current to a variable alternating current in dependence on 
control signals from an axis computer. Each motor has a 
drive of its own. The control system may have one or more 
axis computers. Further, the control system comprises a 
main computer that is adapted to execute a program with 
instructions for the movements and that supplies the axis 




PCT/SE03/00933 



WO 03/103903 



2 



computer with control instructions. These control instruc- 
tions are then transformed by the axis computer into con- 
trol signals for the drives. The function of the axis com- 
puter is thus to ensure that orders from the main computer 
5 are carried out. The task of the main computer is to plan 
the movement path of the robot, so-called path planning, 
and the task of the axis computer is to ensure that the 
robot completes the planned path. The control signals to 
th£ drives determine motor torque, motor speeds and drive 
10 currents for each axis. The main computer also has many 
other tasks, such as handling I/O systems, application 
programs, interpolation, and communication with external 



15 A conventional control system for an industrial robot com- 
prises a coherent unit, where the different parts in the 
control system, such as main computer, axis computer and 
drives, are mounted in one and the same cabinet with a 
common power supply, a common interface externally, and a 

20 common casing. The control system is provided with an in- 
ternal bus for communication between the different parts. 

From European patent No. 728 559 Bl, it is known, instead, 
to arrange the drives directly on the robot. Each one of 

25 the drives is mounted adjacent to the motor that it is to 
control. This is advantageous since the cables between the 
drives and the motor will be shorter, which reduces the 
radiation of high-frequency electromagnetic waves, which in 
turn may cause disturbance. Another advantage of shorter 

30 cables is that the risk of incoming EMC disturbances on the 
control signals is reduced. 

It is common practice to have several robots arranged 
together in manufacturing cells or along a production line. 
35 In such applications, the robots are either provided with 
individual control systems or with a common control system. 
Such a common control system comprises a main computer or 
one or more axis computers as well as one drive unit per 
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robot, A drive unit comprises a plurality of drives, 
usually between six and nine drives depending on how many 
motors are. to be controlled. The axis computers and the 
main computer communicate via an internal bus. 

5 

One disadvantage of these control systems is that they are 
inflexible. If it is desired, for example, to add a new 
function or replace some part of the control system, it is 
necessary today to intervene and make changes in the exist- 

10 ing control system. To be able to add more robots, the 

existing control system must either be oversized even from 
the start regarding computer utility and power supply, or 
the whole of or parts of the control system must be repla- 
ced or be rebuilt to obtain the necessary computer utility 

15 and power supply. 

SUMMARY OF THE INVENTION 

The object of the present invention is to provide a flex- 
20 ible control system for control of one or more manipula- 
tors. The fact that the control system is flexible means 
that it is easy to connect a new manipulator to the control 
system, to add a new function to the control system, and to 
replace some part of the control system. 



This object is achieved according to the invention with the 
control system described in the introductory part of the 
description, which is characterized in that the control 
system comprises a plurality of separate modules, adapted 

30 to handle various functions, whereby each one of the modu- 
les has its own power supply and is adapted to communicate 
with at least one of the other modules, the computers and 
the drive units being arranged in the modules. Each module 
is autonomous and has its own well-defined interface with 

35 respect to the other modules. The separate modules may 

either be placed together or be geographically separated at 
suitable locations. 
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Because the functions of the control system have been divi- 
ded into a plurality of separate modules with their own 
power supply, it is easy to add a new function or to extend 
the capacity of the control system by connecting a new mo- 
5 dule. When something breaks down in the control system, the 
faulty module can simply be replaced. For each module that 
is added, the total power supply of the control system in- 
creases. If a new manipulator is to be connected to the 
control system, it is sufficient to connect' another module 
10 to upgrade the control system. Thus, the control system 
need not be oversized from the start. 

According to the invention, independent functional units 
are identified and separate modules with these functions 

15 are created. In this way, the need of information exchange 
between the modules is reduced, which implies that no high 
bandwidth is needed for the communication channels between 
the modules. This means that it is sufficient to use common 
simple standard protocols for the communication between the 

20 modules and thus inexpensive standard components may be 
used. 

According to a preferred embodiment of the invention, the 
control system comprises a separate main computer module 

25 and at least one separate drive module, the main computer 
being arranged in the main computer module and the axis 
computer being arranged in the drive module. This is ad- 
vantageous when it is desired to connect a new manipulator 
to the control system, since it is sufficient to connect a 

30 new drive module for upgrading the control system both with 
regard to power supply and computer utility. 

According to another preferred embodiment of the invention, 
the control system comprises at least two separate drive 
35 modules. Advantageously, each drive module is adapted to 
control one manipulator. By arranging each drive module to 
control one manipulator, a new drive module is readily con- 
nected each time a new unit is added. 
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According to a further preferred embodiment of the inven- 
tion, said drive module comprises a drive unit comprising a 
plurality of drives. One advantage of mounting the drives 
together with the axis computer is that it will be easy to 
connect a new manipulator. The power supply to the drive 
module is adapted to the number of drives. When the control 
system is extended by another drive module, the power supp- 
ly is automatically adapted to the number of drives and 
hence to the number of connected manipulators. One advan- 
tage of mounting all the drives together in the same module 
is that this makes it possible to provide the drives with a 
common cooling system. 

According to still another embodiment of the invention, the 
control system comprises a separate transformer module, 
which has a transformer and is adapted to transform the 
incoming ac voltage to the correct voltage level for the 
modules. Different countries deliver alternating current 
with different voltage levels. Whether a transformer is 
needed, and in that case which one, depends on the country 
in which the system is to operate. Because the transformer 
is arranged as a separate module, the module is easily re- 
placed if another transformer is needed. 

According to yet another embodiment of the invention, the 
control system comprises a separate control-panel module 
with. the control panel of the control system. By arranging 
the control panel in a separate module, it is possible to 
integrate the control panel into some other piece of equip- 
ment so as to make it easily accessible to the operator. 

According to a further embodiment of the invention, each 
one of the modules is enclosed in its own casing. The 
casing protects the modules against the environment and 
makes it possible to place the modules separately. The 
modules are advantageously arranged physically separated. 
In this way f the modules may be easily spread out and 
placed in different places. In many cases, it is advan- 




* 



PCT/SE03/00933 



WO 03/103903 



6 



tageous to be able to spread out the modules in different 
places. The drive modules are preferably located as close 
to the motors as possible to obtain short cables which are 
less sensitive to EMC disturbances. In many branches of 
5 industry, there is a shortage of floor space due to com- 
pressed manufacturing cells and lines. With a drive system 
according to the invention, it is possible to place the 
various modules where there is free floor space. 

10 According to another embodiment of the invention, at least 
some of the modules are arranged to communicate via the 
Ethernet. Ethernet is a simple standard protocol. By ar- 
ranging the modules so that they can use the Ethernet, in- 
expensive standard components may be used. 



According to still another embodiment of the invention, the 
control system comprises at least three such modules. A 
control system may comprise many modules, of which some 
modules handle different functions and others handle the 

20 same function. It is thus possible that the control system 
may comprise several modules with the same function. By the 
characteristic feature that the control system comprises at 
least three modules is meant that the control system com- 
prises three modules irrespective of whether these handle 

25 different functions or the same function. 

An additional object of the invention is to suggest a 
method for controlling one or more manipulators. This 
object is achieved with a method that is characterized in 

30 that said one or more computers and drive units are ar- 
ranged in modules, that the modules are arranged with their 
own power supply, and that the modules are brought to com- 
municate with at least one of the other modules. The con- 
trol system is divided into a plurality of separate modules 

35 adapted to handle different functions, whereby the modules 
are provided with their own power supply and are brought to 
communicate with at least one of the other modules. 
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Although not explicitly described in the claims, the inven- 
tion also covers the method in combination with the charac- 
teristic features of the control system according to any of 
the appended claims. 

5 

BRIEF DESCRIPTION OF THE DRAWINGS 



The invention will now be explained in greater detail by 
means of various exemplary embodiments with reference to 
10 the accompanying drawing. 

Figure 1 shows a control system according to the prior art, 

Figure 2 shows a control system according to a first 
15 embodiment of the invention, 

Figure 3 shows a control system according to a second 
embodiment of the invention, 

20 Figure 4 shows the control system in greater detail - 



DESCRIPTION OF THE PREFERRED EMBODIMENTS 

Figure 1 shows a control system 1 according to the prior 
25 art, controlling three industrial robots 2. The control 

system 1 comprises a main computer 4, three axis computers 
6 and three drive units 8, each of which including a number 
of drives. Each drive unit 8 is connected to a robot 2 and 
supplies the robot with control signals and electric power. 
30 The main computer, the axis computers and the drive units 
are arranged together and constitute one unit that is en- 
closed by a common casing 10. The control system has a 
common power- supply unit that produces voltages with the 
correct quality and with the correct level for all parts 
35 included in the control system. The main computer and the 
axis computers communicate with each other and with the 
drive units via an internal bus (not shown in the figure) . 
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A control system according to the invention comprises at 
least three separate modules, which are arranged to handle 
different functions. A plurality of different types of 
modules are available and each type of module has its own 
5 function. Each module has its own well-defined interface 
with respect to the other modules. When the modules axe 
interconnected, they form a control system with all the 
functions of a conventional control system. The control 
system composed of the separate modules need not include 
10 all types of modules and may include several modules of the 
same type. The modules have their own power supply and are 
arranged so as to be able to communicate with at least one 
of the other modules. A plurality of the different types of 
modules are also provided with their own computer utility. 

15 

Figure 2 shows a control system according to one embodiment 
of the invention, controlling three robots 2. The figure 
shows four modules, one main-computer module 12 and three 
drive modules 14. The control system also comprises other 

20 modules that are not shown in the figure. The main-computer 
module 12 comprises the main computer 4 of the control sys- 
tem and handles the functions of the main computer, such as 
executing robot programs and giving orders to the drive 
module regarding the movement of the robot, such as the 

25 desired position and speed. Each one of the drive modules 
14 comprises an axis computer 6 and a drive unit 8. The 
function of the drive module is to carry out the orders of 
the main computer so that the robot carries out the move- 
ment ordered. Each module 12, 14 is enclosed in its own 

30 casing 15 and constitutes a separate physical unit. Each 
one of the drive modules 14 is directly connected to the 
main-computer module and communicates therewith via an 
Ethernet link. 

35 Figure 3 shows another embodiment of a control system 

according to the invention, wherein the drive modules 14 
instead are arranged in series. The first drive module is 
connected to the main-computer module 12 and to the second 
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drive module, which in turn is connected to the third drive 
module. These connections comprise communication via the 
Ethernet. Electric power is transmitted separately to each 
module. 

Figure 4 shows in more detail an embodiment of a control 
system according to the invention. The control system com- 
prises five different types of modules: one main-computer 
module 12, one drive module 14 r one control* module 16, one 
transformer module 18, and one client I/O module 20. The 
main-computer module 12 includes the main computer, the 
communication card (RCC) of the robot, and one or more 
field bus cards. The main computer constitutes the centre 
of the system and it controls and reacts to communication 
from other parts of the system. The main computer executes 
robot programs and gives orders to the drive module regar- 
ding the position and speed of the robot. The drive module 
14 comprises a drive unit with up to nine drives, an axis 
computer and a contactor card. A drive module may thus 
drive a six-axis robot with three external axes . 

The control module 16 comprises an operating panel with 
built-in power supply and the control panel of the control 
system with an emergency- stop button and buttons for selec- 
ting various settings as well as a main switch. The control 
module 16 constitutes the centre of the safety functions of 
the robot and it supervises the whole safety chain. Most of 
the external safety signals for the robot are connected to 
the operating panel. The control module preferably includes 
a computer. A portable programming unit (TPU) 22 is also 
connected to the control module 16. The programming unit 22 
is used by an operator for programming the robot. The 
client I/O module comprises I/O panels and is adapted to 
receive electric equipment or other electronics. What type 
of electronics or equipment to install into the module is 
determined by the robot user. The equipment installed may, 
for example, be a welding machine or a painting machine. It 
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is possible for the user to make external changes in this 
module so as to suit the requirements of the user. 

The transformer module 18 comprises a transformer and a 
5 switch. The transformer module is supplied with ac voltage 
from the electricity network and transforms the ac voltage 
into the desired voltage level. The transformer module in 
turn supplies the other modules with ac voltage. All the 
modules have their own power supply, which means that they 
10 are provided with a power-supply unit 26 that converts in- 
coming alternating current into direct current and produces 
the voltages that are needed in the module. The power- 
supply units 26 produce voltages of the correct quality and 
of the correct level for its module. 

15 

Each one of the modules 12-20 is enclosed in a casing for 
protection against pollutants in the surroundings. The 
modules that are in need thereof are provided with their 
own cooling system. A voltage arriving at the transformer 

20 module 18 is transformed by the transformer into a suitable 
voltage level and is then supplied to the modules via the 
cables 24a-c connected to the power-supply unit 26 in the 
modules. In this embodiment, the main-computer module 12 
communicates with the control module 16 via an Ethernet 

25 cable 28a. The main-computer module 12 also communicates 
with the drive module 14 via an Ethernet cable 28b. The 
main. computer supplies the axis computer in the drive 
module with new references every fourth ms. The main- 
computer module 12 and the client I/O module 20 are connec- 

30 ted to each other via a field bus 30. 

Which modules, and how many of each type, are included in 
the control system varies depending on the application. 
There should be at least a main-computer module, a drive 
35 module and a control module. The control system may have no 
or several transformer modules and no or several client I/O 
modules, respectively. In a small robot configuration, the 
transformer may instead be located in the drive module. 
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The invention is not limited to the embodiments shown but 
may be varied and modified within the scope of the appended 
claims. The division of the modules with respect to what 
functions they are to handle may be done in other ways than 
5 those shown in the above-described embodiments. The number 
of different types of modules may also vary. The principle 
for the division of the functions of the control system 
into different modules is that these functions are divided 
in such a way as to require as small an exchange of infor- 
10 mation between the modules as possible. In another embodi- 
ment of the invention, the drive module comprises only the 
axis computer and the drives are instead arranged on the 
robot adjacent to the motors. 



15 
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CLAIMS 

1. A control system for controlling one or more manipula- 
tors (2), wherein the control system comprises one or more 

5 computers (4, 6) and one or more drive units (8) for con- 
trolling the manipulator, characterized in that the control 
system comprises a plurality of separate modules (12, 14, 
16, 18, 20) adapted to handle different functions, whereby 
each of the modules has its own power supply (26) and is 
10 adapted to communicate with at least one of the other mo- 
dules, and that said one or more computers (4, 6) and drive 
units (8) are arranged in the modules. 

2. A control system according to claim 1, characterized in 
15 that the control system comprises drives that control mo- 
tors driving the movements of the manipulator, an axis 
computer (6) that provides control signals to the drives, 
and a main computer (4) that is adapted to execute a pro- 
gram with instructions for the movements and that supplies 

20 the axis computer with control instructions, whereby one of 
said modules is a main-computer module (12) comprising the 
main computer (4) and another one of said modules is a 
drive module (14) comprising the axis computer (6). 

25 3. A control system according to claim 2, characterized in 
that the control system comprises at least two separate 
drive modules . 

4. A control system according to claim 3, characterized in 
30 that each drive module (14) is adapted to control a manipu- 
lator (2) . 

5. A control system according to any of claims 2-4, 
characterized in that said drive module (14) comprises a 

35 drive unit (8) that includes one or more drives. 
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6. A control system according to any of claims 2-5, 
characterized in that one of said modules is a transformer 
module (18) that includes a transformer. 

7. A control system according to any of the preceding 
claims, characterized in that one of said modules is a con- 
trol module (16) that comprises the control panel of the 
control system. 

8. A control system according to any of the preceding 
claims, characterized in that each one of modules is 
surrounded by its own casing (15) . 

9. A control system according to any of the preceding 
claims, characterized in that the modules are arranged 
physically separated. 

10. A control system according to any of the preceding 
claims, characterized in that at least some of the modules 
are adapted to communicate via Ethernet. 

11. A control system according to any of the preceding 
claims, characterized in that said manipulator is an in- 
dustrial robot (2) . 

12. A control system according to any of the preceding 
claims, characterized in that the control system comprises 
at least three modules . 

13 . Use of a control system according to any of claims 1-11 
for controlling an industrial robot. 

14. A method for controlling one or more manipulators (2), 
wherein the control system comprises one or more computers 
(4, 6) and drive units (8) for controlling the manipulator, 
characterized in that said one or more computers and drive 
units are arranged in modules (12, 14, 16, 18, 20), and 
that the modules are arranged with their own power supply 
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(26) and that the modules are brought to communicate with 
at least one of the other modules. 

15. A method according to claim 14, characterized in that 
5 the control system comprises drives that control motors 
driving the movements of the manipulator, an axis computer 
(6) that provides control signals to the drives, and a main 
computer (4) that is adapted to execute a program with in- 
structions for the movements and that supplies the axis 
10 computer with control instructions, whereby the axis com- 
puter and the main computer are arranged in separate mo- 
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